OctoMapPointArray mapPoints
geometry_msgs/PoseWithCovarianceStamped keyFramePose

